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Prufungsantrag gem. § 44 PatG ist gestellt 

@ Verfahren zum Bestimmen relevanter Punkte eines Werkzeugs am Handf lansch eines gesteuerten 
mehrachsigen Manipulators 

(§) Die Erfindung betrifft ein Verfahren zum Bestimmen 
relevanter Punkte eines Werkzeuges (4) am Handf lansch 
eines gesteuerten mehrachsigen Manipulators (1). Die rele- 
vanten Punkte (5, 6, 7) werden im manipulatoreigenen 
World-Koordinaten-System bestimmt Hierzu fahrt der Ma- 
nipulator (1) mit dem gesuchten relevanten Punkt (5, 6, 7) 
einen externen Referenzpunkt (10) mit bekannten Ortskoor- 
dinaten im World-Koordinaten-System (8) an. Dort wird 
anhand des Referenzpunktes (10) die Lage und Orientierung 
des Flansch-Koordinaten-Systems (9) des Manipulators (1) 
gegenuber dem World-Koordinaten-System (8) in der Mani- 
pulator- Steuerung (15) berechnet. Durch Koordinatentrans- 
formation sind anschlie&end Lage und Orientierung des 
m gesuchten relevanten Punktes (5, 6, 7) im Flansch-Koordina- 
ten -System (9) errechenbar. Hierzu wird der Referenzpunkt 
( (10) in mindestens drei gewahlte representative Punkte (16, 
17, 18, 19) des Flansch-Koordinaten-Systems (9) tief vertegt. 
Hierbei werden die Ortskoordinaten der reprasentativen 
Punkte (16. 17, 18, 19) im World- Koordinaten- System (8) 
aufgenommen und daraus die Lage und Orientierung des 
Flansch-Koordinaten-Systems (9) gegenuber dem World- 
Koordinaten-System (8) berechnet. 
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Beschreibung 

Die Erfindung betrifft ein Verfahren mit den Merk- 
malen im Oberbegriff des Hauptanspruches. 

In der Praxis besteht ein groBes Problem mit dem 
Austausch und der Vermessung neuer manipulatorge- 
fuhrter Werkzeuge. Damit die Manipulatorsteuerung 
ein Werkzeug exakt bewegen und positionieren kann, 
muB sie wissen, wo sich die relevanten Werkzeugpunk- 
te, insbesondere der sogenannte Tool-Center-Point, be- 
finden. Hierzu mussen standig die Ortskoordinaten die- 
ser relevanten Punkte im manipulatoreigenen World- 
Koordinaten-System bekannt sein. Die Koordinatenbe- 
schreibung erfolgt durch zwei Beziehungen, namlich 
einmal die relative Lage und Orientierung des relevan- 
ten Punktes innerhalb des Flansch-Koordinaten-Sy- 
stems der Manipulatorhand und zum anderen durch die 
Lage und Orientierung dieses Systems gegenuber dem 
World- Koordinaten-System. Beim Wechsel eines Werk- 
zeugs andern sich die relative Lage und Orientierung 
der relevanten Punkte gegenuber dem Flansch- Koordi- 
naten-System. In der Praxis war es daher bislang not- 
wendig, jedes Werkstuck exakt vor dem Gebrauch zu 
vermessen und dann lagegenau am Handflansch zu be- 
festigen. Durch diese externe und sehr aufwendige 
Werkzeugvermessung konnten dann die Relativwerte 
fur Lage und Orientierung im Flansch- Koordinaten-Sy- 
stem von Hand ermittelt und in die Manipulatorsteue- 
rung eingegeben werden. Ein Werkzeugwechsel be- 
dingte demnach einen erheblichen Aufwand und ent- 
sprechende Kosten. 

Es ist daher Aufgabe der vorliegenden Erfindung, ein 
einfacheres, praktischeres und kostengunstigeres Ver- 
fahren zum Bestimmen der relevanten Punkte eines 
Werkzeugs aufzuzeigen. 

Die Erfindung lost diese Aufgabe mit den Merkmalen 
im Hauptanspruch. 

Mit der Erfindung ist keine externe Werkzeugver- 
messung mehr notwendig. Vielmehr findet die Bestim- 
mung der relevanten Punkte am Manipulator mit dem 
angebauten Werkzeug statt und geht auch mit sehr viel 
weniger Bau-, Zeit- und Kostenaufwand vor sich. 

Es genugt den gesuchten relevanten Punkt des Werk- 
zeugs an einen externen, d h. im Arbeitsraum des Mani- 
pulators liegenden Referenzpunkt mit bekannten Orts- 
koordinaten im World-Koordinaten-System zu verfah- 
rea An dieser Stelle hat der gesuchte relevante Punkt 
bekannte absolute Ortskoordinaten, namlich die des Re- 
ferenzpunktes. Hieraus laBt sich zum einen die bis dahin 
unbekannte relative Lage und Orientierung des 
Flansch- Koordinaten-Systems gegenuber dem World- 
Koordinaten-System ermitteln. Aus zwei bekannten 
Koordinatensystemen konnen wiederum die Ortskoor- 
dinaten des Referenzpunktes bzw. des dort befindlichen 
relevanten Werkzeugpunktes in das Flansch-Koordina- 
ten-System transformiert werden. Aus diesen beiden re- 
lativen Ortskoordinaten taBt sich wiederum die Lage 
und Orientierung des relevanten Punktes gegenuber 
dem Flansch-Koordinaten-System berechnen. In der 
Regel geht es hierbei urn den Abstand (T), den Seiten- 
versatz (L) und den Drehwinkel (D) um die z- Achse des 
relevanten Punktes gegenuber dem Handflansch. 

Das Verfahren kann vereinfacht werden, wenn in der 
Bahnensteuerung schon die Lage und Orientierung des 
Flansch-Koordinaten-Systems gegenuber dem World- 
Koordinaten-System bekannt und abrufbar ist Der Er- 
mittlungsschritt der Relativbeziehung zwischen den bei- 
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momentanen Steuerungen ist dies zwar grundsatzlich 
moglich, aber noch nicht in der Praxis realisiert 

Das erfindungsgemaBe Verfahren eignet sich fur be- 
liebige Werkzeuge und auch fur beliebige relevante 

5 Punkte. Es ist fur mehrachsige Manipulatoren und ins- 
besondere fur mehrachsige Industrieroboter geeignet 
Es dient nicht nur zur Vermessung neuer Werkzeuge, 
sondern kann auch zur Kontrolle benutzter Werkzeuge 
auf eventuelle Schaden verwendet werden. 

io Fur die Bestimmung des Referenzpunktes gibt es ver- 
schiedene Mdglichkeiten. Im einfachsten Fall ist der Re- 
ferenzpunkt irgendwo im Arbeitsraum des Manipula- 
tors, eventuell sogar am Manipulator selbst posttioniert 
und bereits vorab vermessen. Um die Vermessung zu 

15 vereinfachen, kann hierfur auch der Manipulator mit 
. einem bereits bekannten Werkzeug eingesetzt werden. 
Dessen ebenfalls bekannten relevanter Punkt beispiels- 
weise der Tool-Center-Point wird auf den Referenz- 
punkt gefahren, wobei die mitgefuhrten absoluten Orts- 

20 koordinaten des relevanten Punktes aufgenommen und 
dann dem Referenzpunkt in der Steuerung zugeordnet 
werden. In der Praxis laBt sich dies auf einfache Weise 
mit einem Dorn realisieren, dessen Spitze den Referenz- 
punkt markiert 

25 Um einen hoheren Komfort und insbesondere auch 
eine Mdglichkeit zur Automatisierung des Bestim- 
mungsvorganges zu erreichen, wird der gesuchte rele- 
vante Punkt selbst als Referenzpunkt herangezogen. 
Dies ist mit Hilfe eines auf das World-Koordinaten-Sy- 

30 stem referierten Vermessungssystems moglich, das den 
gesuchten relativen Punkt erfaBt und dessen Ortskoor- 
dinaten bestimmt Vorteilhafterweise muB dazu nicht 
unbedingt ein bestimmter Punkt im Arbeitsraum ange- 
fahren werden, sondern es genugt irgendeine frei wahl- 

35 bare Stelle im Erfassungsraum des Vermessungssy- 
stems. Dadurch kann der Manipulator den Bestim- 
mungsvorgang selbsttatig und automatisch durchfuh- 
ren, da er keinen bestimmten Referenzpunkt mehr an- 
steuern muB. 

40 Das Vermessungssystem kann in unterschiedlicher 
Weise realisiert werden, beispielsweise als Laser- Re- 
• flex-System, Radar oder auf sonstige Art Bevorzugt 
wird die optische Messung mit einem Kamerasystem, 
das besonders exakte Positionswerte des relevanten 

45 Punktes im Raum liefert und zuverllssig arbeitet Ein 
solches Kamerasystem ist im ubrigen auch fur andere 
Zwecke bei Industrierobotern ohnehin haufig schon im 
Einsatz. 

In weiterer Alternative kann auch ein unbekannter 
50 mechanischer Referenzpunkt beispielsweise ein Dorn, 
mit einem ebenfalls unbekannten Werkzeug viermal aus 
verschiedenen Richtungen angefahren werden. In alien 
vier Positionen werden von der Manipulatorsteuerung 
die gemeldeten Ortskoordinaten im World-Koordina- 
55 ten-System aufgenommen und miteinander verglichen. 
Nachdem sich das Werkzeug nicht andert und immer 
mit dem gleichen relevanten Punkt den Referenzpunkt 
beruhrt, mussen die aufgenommenen vier Punkte auf 
einer Kugel um den Referenzpunkt liegen, deren Mittel- 
60 punkt und damit der Referenzpunkt sich dann ohne wei- 
teres errechnen laBt 

Die Erfindung ist in den Zeichnungen beispielsweise 
und schematisch dargestellt Im einzelnen zeigen 
Fig. 1 in perspektivischer Ansicht und schematischer 
65 Darstellung einen Industrieroboter mit einem zu ver- 
messenden Werkzeug und 
Fig. 2 eine vergroBerte Darstellung des Handflan- 
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Der in Fig. 1 gezeigte sechs-achsige Industneroboter 
(!) besitzt eine mehrfach abwinkelbare Hand (2) in 
Form einer sogenannten Zentralhand, die am vorderen 
Ende einen Handflansch (3) tragt Am Handflansch (3) 
ist ein Werkzeug (4) befestigt das im gezeigten Ausfuh- 
rungsbeispiel mehrfach abgewinkelt ist und drei rele- 
vante Punkte (5, 6 ( 7) tragt Der relevante Punkt (5) an 
der Werkzeugspitze ist der sogenannte Tool-Center- 
Point auf den die Manipulatorsteuerung (15) die Robo- 
terbewegungen abstimmt Der Tool-Center-Point ist 
beispielsweise bei einem SchweiBbrenner die Spitze des 
aus der Duse tretenden SchweiBdrahtes. Der zweite re- 
levante Punkt (6) ist beispielsweise ein vorstehender 
Ansatz, der Kollisionsprobleme aufwerf en kann und da- 
her in der Manipulatorsteuerung (15) bei den Werk- 
zeugbewegungen berucksichtigt werden mufl. Ahnli- 
ches gilt fur den dritten relevanten Punkt (7% der bei- 
spielsweise ein Knickpunkt ist Die relevanten Punkte 
(6, 7) konnen auch Achsen eines in sich beweglichen 
Werkzeugs seirt In Abwandlung des gezeigten AusfQh- 
rungsbeispiels kann ein Werkzeug (4) auch nur einen 
relevanten Punkt oder eine beliebige groBere Zahl sol- 
dier Punkte haben. 

Die Positionswerte des Werkzeugs (4) und die Robo- 
terbewegungen sind auf ein manipulatoreigenes World- 
Koordinaten-System (8) bezogen, das vorzugsweise 
kartesisch ist Der Handflansch (3) besitzt ein eigenes 
Flansch-Koordinaten-System (9), das ebenfalls vorzugs- 
weise kartesisch ist Der Ursprung des Flansch-Koordi- 
naten-Systems (9) ist zugleich der Flanschmittelpunkt 

Die relevanten Punkte (5, 6, 7) des Werkzeugs (4) 
stehen in einer bestimmten Lage und Orientierung zum 
Flansch-Koordinaten-System (9). Im gezeigten Ausfuh- 
rungsbeispiel wird diese Beziehung durch den Abstand 
(T) entlang der z-Achse, den Seitenversatz (L) entlang 
der x-Achse und den Drehwinkel (D) um die z-Achse 
definiert Mit diesen drei Werten ist die relative Lage 
und Orientierung des betrachteten relativen Punktes (5, 
6, 7) gegenuber dem Flansch-Koordinaten-System (9) 
festgelegt 

Die relative Lage und Orientierung des Flansch-Ko- 
ordinaten-Systems (9) gegenuber dem World-Koordi- 
naten-System ist in der Manipulatorsteuerung (15) zwar 
bekannt aber nicht in Parameterform durch Anzeige 
abrufbar. In der Manipulatorsteuerung (15) liegen je- 
doch bei einem bekannten Werkzeug die Ortskoordina- 
ten der relevanten Punkte (5, 6, 7) im World-Koordina- 
ten-System abrufbar und anzeigbar'vor. Sie setzen sich 
durch Koordinatentransformation aus der Relativbezie- 
hung zwischen den relevanten Punkten und dem 
Flansch-Koordinaten-System und dessen Relativbezie- 
hung gegenuber dem World- Koordina ten-System zu- 
sammea 

Bei einem Werkzeugwechsel oder einer Kollision des 
Werkzeugs (4) mit einem Hindernis ist die Lage und 
Orientierung eines oder mehrerer der relevanten Punk- 
te (5, 6, 7) gegenuber dem Flansch-Koordinaten-System 

(9) nicht oder nicht mehr bekannt und muB neu be- 
stimmt werden. Dieser Bestimmungsvorgang lauft wie 
folgtab: 

Das unbekannte oder beschadigte Werkzeug (4) wird 
mit dem zu bestimmenden relevanten Punkt (5, 6, 7) vom 
Roboter (1) im Arbeitsraum auf einen Referenzpunkt 

(10) gefahren. Im gezeigten Ausfuhrungsbeispiel besteht 
dieser aus der Spitze eines ortsfesten Kegels (11), die 
beim Anfahren punktgenau beruhrt wird Die Ortskoor- 
dinaten des Referenzpunktes (10) liegen im World-Ko- 
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stimmt worden oder werden wahrend des Anfahrens 
durch den relevanten Punkt (5, 6, 7) bestimmt Die ver- 
schiedenen Alternativen werden nachfolgend niher er- 
lautert FQr die weitere Erkl&rung des Verfahrens zur 
5 Bestimmung der gesuchten relativen Punkte (5, 6, 7) 
werden die absoluten Ortskoordinaten des Referenz- 
punktes (10) im World-Koordinaten-System (8) als be- 
kannt angenommen. 
Wenn sich der gesuchte relevante Punkt (5, 6, 7) am 
io Referenzpunkt (10) befindet werden in der Bahnen- 
steuerung die bekannten Ortskoordinaten dem relevan- 
ten Punkt (5, 6, 7) zugeordnet FQr die nachfolgende 
Bestimmungsoperation bleiben der Manipulator (1) mit 
dem Werkzeug (4) und dem zu bestimmenden relevan- 
is ten Punkt (5, 6, 7) ortsfest stehea 

Wenn die relative Lage des Flansch- Koordina ten-Sy- 
stems gegenuber dem World-Koordinaten-System (8) 
nicht abrufbar ist wird sie durch den nachfolgenden 
Verfahrensabschnitt ermittelt Wie eingangs erwahnt 
20 setzt sich der Ortsvektor vom Koordinatenursprung 
bzw. dem Ranschmittelpunkt zum betrachteten rele- 
vanten Punkt (5, 6, 7) aus den achsbezogenen Abstanden 
(T) und (L) zusammeit Zur Bestimmung der Lage und 
Orientierung des Flansch-Koordinaten-System (9) ge- 
25 genuber dem World-Koordinaten-System (8) wird der 
Referenzpunkt (10) bzw. der betrachtete relevante 
Punkt (5, 6, 7) auf mindestens drei, vorzugsweise vier 
gewahlte Punkte (16, 17, 18, 19) verlegt und sozusagen 
abgebildet Die Punkte (16, 17, 18, 19) sind reprasentativ 
30 fur das Flansch-Koordinaten-System und liegen auf des- 
sen verschiedenen Achsea Bei der Verlegung wird der 
betrachtete relevante Punkt (5, 6, 7) ftktiv auf dem 
Flansch-Koordinaten-System (9) abgebildet und sozusa- 
gen umdefiniert Es werden hierdurch drei oder vier 
35 neue Ortskoordinaten der reprasentativen Punkte (16, 
17, 18, 19) im World-Koordinaten-System (8) gewonnen. 

In der gezeigten Ausfuhrungsform wird der Tool- 
Center- Point (5) betrachtet Wie Fig. 2 zeigt werden bei 
einem Drehwinkel (D) - 0 (T) und (L) ebenfalls als 0 
40 definiert Der Tool-Center-Point (5) kommt damit fiktiv 
auf dem Koordinatenursprung des Flansch-Koordina- 
ten-Systems (9) zu liegen, wobei in der Manipulator- 
steuerung (15) entsprechende Ortskoordinaten fur die- 
sen reprasentativen Punkt (16) im World-Koordinaten- 
45 System (8) ausgegeben und gegebenenfalls gespeichert 
werden. Durch Definition von (D) und (L) = 0 wird der 
Tool-Center- Point (5) auf dem reprasentativen Punkt 
(17) der L-Achse abgebildet der vom Koordinatenur- 
sprung den Abstand (T) hat Desweiteren wird durch (D) 
50 und (T) = 0 der Tool-Center-Point (5) auf dem dritten 
reprasentativen Punkt (18) der x-Achse abgebildet der 
vom Koordinatenursprung den Abstand (L) hat Gege- 
benenfalls kann auf der y-Achse aus den reprasentati- 
ven Punkten (16, 17, 18) ein vierter reprasentativer 
55 Punkt (19) unter Vorgabe von (D) ■» 0 errechnet wer- 
den. Durch die reprasentativen Punkte (16, 17, 18, 19) 
und deren Ortskoordinaten im World-Koordinaten-Sy- 
stem (8) ist das Flansch-Koordinaten-System (9) eindeu- 
tig in der Translation und Rotation gegenuber dem 
6o World-Koordinaten-System (8) bestimmt 

Durch die Relativbeziehung zwischen den beiden Ko- 
ordinatensystemen (8, 9) kdnnen nun auch Ortskoordi- 
naten beliebiger Punkte vom einen in das andere Koor- 
dinatensystem (8, 9) transformiert werden. Durch Koor- 
65 dinatentransformation werden nun die Ortskoordinaten 
des Tool-Center- Points (5) im Flansch-Koordinaten-Sy- 
stem (9) errechnet Aus diesem Ortsvektor wiederum 

i m /i \ i /r\\ m_ a — t — i n_:_» 
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neuen oder beschadigten Werkzeugs errechnet und als 
Parameter in der Manipulatorsteuerung (15) gespei- 
chert Die Bestimmung des Tool-Center- Points (5) ist 
damit abgeschlossen. Die weiteren relevanten Punkte 
(6, 7) konnen auf die gleiche vorbeschriebene Weise 
bestimmt werden. 

Die Durchfuhrung der Rechenoperationen kann an- 
hand der von der Manipulatorsteuerung (15) angezeig- 
ten Ortskoordinaten von Hand durchgefuhrt werden. In 
der bevorzugten Ausfuhrungsform hat die Manipulator- 
steuerung (15) ein integriertes Rechen- oder Software- 
modul, das die Operationen automatisch und intern 
durchfuhrt Fur die Bestimmung der weiteren relevan- 
ten Punkte (6, 7) konnen damit auch die bereits aufge- 
fundenen reprasentativen Punkte (16, 17, 18, 19) bzw. 
das Flansch-Koordinaten-System (9) beim Anfahren der 
nachsten relevanten Punkte (6, 7) mitgenommen wer- 
den, so daB Lage und Orientierung des Flansch-Koordi- 
naten-Systems (9) gegenuber dem World-Koordinaten- 
System (8) auch an den weiteren Punkten sofort zur 
Verf Qgung stehen. 

Die Ermittlung der Ortskoordinaten des Referenz- 
punktes (10) im World-Koordinaten-System (8) ist auf 
verschiedene Weise mdglich. Zum einen kann der Robo- 
ter (1) ein bekanntes Werkzeug (4) mit einem bekannten 
Tool-Center-Point (5) oder einem sonstigen relevanten 
Punkt auf den Referenzpunkt (10) bewegen. Die Mani- 
pulatorsteuerung (15) ubemimmt dann die im World- 
ICoordinaten-System (8) mitgefuhrten und angezeigten 
Ortskoordinaten des bekannten Tool-Center-Points (5) 
und ordnet sie dem Referenzpunkt (10) zu. Anschlie- 
Bend wird das bekannte Werkzeug (4) gegen das unbe- 
kannte getauscht und dann das vorstehend beschriebe- 
ne Bestimmungsverfahren durchgefuhrt 

Eine zweite Moglichkeit zur Bestimmung der Ortsko- 
ordinaten des Referenzpunktes (10) besteht darin, mit 
einem unbekannten Werkzeug (4) und einem demge- 
maB unbekannten relevanten Punkt (5, 6, 7) den eben- 
falls unbekannten Referenzpunkt (10) von Hand mit 
dem Manipulator anzufahren. Das Anfahren findet vier- 
mal aus verschiedenen Richtungen und mit verschiede- 
nen Achsstellungen des Roboters (1) statt Jedesmal 
werden dabei die in der Manipulatorsteuerung (15) an- 
gezeigten absoluten Ortskoordinaten in der eingangs 
beschriebenen Weise auf den Flanschmittelpunkt (16) 
durch Definition von (D, T, L) = 0 abgebildet Die ange- 
gebenen Ortskoordinaten der vier Punkte sind zwar we- 
gen des noch nicht vermessenen Werkzeugs (4) als ein- 
zelne Absolutwerte unrichtig. Zusammen definieren sie 
aber vier Punkte einer Kuge! deren Mittelpunkt der 
Referenzpunkt (10) ist Aus den Ortskoordinaten kann 
uber die Kugelbeziehung dann ein korrekter Positions- 
wert fur den Referenzpunkt (10) im Worldkoordinaten- 
system (8) errechnet werden. Beim vierten Anfahren 
wird auBerdem in der eingangs beschriebenen Weise 
durch Abbildung des nun korrekten Referenzpunktes 
(10) auf drei oder vier representative Punkte (16, 17, 18, 
19) das Flanschkoordinatensystem (9) bestimmt Der 
weitere Bestimmungsvorgang fur den gesuchten rele- 
vanten Punkt (5, 6, 7) findet ebenfalls in der vorgeschrie- 
benen Weise statt 

Eine dritte Moglichkeit besteht im Einsatz eines Ver- 
messungssys terns (12), das den gesuchten relevanten 
Punkt (5, 6, 7) erfaBt und seine Position in Ortskoordina- 
ten des Worldkoordinatensystems(8) angibt lm gezeig- 
ten Ausfuhrungsbeispiel besteht das Vermessungssy- 
stem (12) aus zwei ICameras (13), die einen internen 



ten und eine Auswerteschaltung (14) aufweisen Das 
Vermessungssystem (12) hat ein eigenes Koordinaten- 
system, das bei der Einrichtung uber eine Koordinaten- 
transformation auf das Worldkoordinatensystem (8) re- 

s feriert wird. Die Einrichtung kann mit Hilfe eines be- 
kannten Werkzeuges (4) und dessen Tool-Center-Point 
(5) mit bekannten Ortskoordinaten erfolgen. Urn den 
Tool-Center-Point (5) der verschiedenen Werkzeuge (4) 
oder einen sonstigen relevanten Punkt (6, 7) zuverlassig 

io erfassen zu konnen, ist an diesen Stellen eine LED ange- 
ordnet Zur Bestimmung eines relevanten Punktes (5, 6, 
7) eines unbekannten oder beschadigten Werkzeugs (4) 
wird dieser Punkt vom Roboter (1) an irgendeine Stelle 
im Erfassungsraum des Vermessungssystems (12) be- 

15 wegt Im Gegensatz zu den vorgenannten Positionier- 
verfahren kann dies auch automatisch und uber die Ma- 
nipulatorsteuerung (15) geschehen. Die eingenommene 
Stellung des relevanten Punktes (5, 6, 7) ist zugleich der 
Referenzpunkt (10) dessen Ortskoordinaten vom Ver- 

20 messunssystem (12) aufgenommen und im Worldkoordi- 
natensystem (8) angezeigt werden und in die Manipula- 
torsteuerung (15) eingegeben werden. Der weitere Be- 
stimmungsvorgang lauft in der eingangs beschriebenen 
Weise ab. 

25 

Stuckliste 

1 Manipulator, Industrieroboter 

2 Hand 

30 3 Handflansch 

4 Werkzeug 

5 relevanter Punkt, Tool-Center- Point 

6 relevanter Punkt Ansatz 

7 relevanter Punkt Knickpunkt 
35 8 World- Koordinaten-Syst em 

9 Flansch-Koordinaten-System 

10 Referenzpunkt 

11 Dorn 

12 Vermessungssystem, Kamerasystem 
40 13 Kamera 

14 Auswerteschaltung 

15 Manipulatorsteuerung 

16 reprasentativer Punkt Ursprung, 
Flanschmittelpunkt 

45 17 reprasentativer Punkt z-Achse 

18 reprasentativer Punkt x-Achse 

19 reprasentativer Punkt y-Achse 

Patentanspruche 
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1. Verfahren zum Bestimmen relevanter Punkte ei- 
nes Werkzeugs am Handflansch eines gesteuerten 
mehrachsigen Manipulators im manipulatoreige- 
nen World-Koordinaten-System, wobei der rele- 
vante Punkt in der Manipulatorsteuerung durch 
seine relative Lage und Orientierung innerhalb des 
Flansch-Koordinaten-Systems und dessen Lage 
und Orientierung gegenuber dem World-Koordi- 
naten-System beschrieben wird, dadurch gekenn- 
zeichnet daB der Manipulator (1) mit dem relevan- 
ten Punkt (5, 6, 7) des Werkzeugs (5) einen externen 
Referenzpunkt (10) mit bekannten Ortskoordina- 
ten im World-Koordinaten-System (8) anfahrt wo* 
nach dort anhand des Referenzpunktes (10) die La- 
ge und Orientierung des Flansch-Koordinaten-Sy- 
stems (9) gegenuber dem World-Koordinaten-Sy- 
stem (8) in der Manipulatorsteuerung (15) berech- 
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mation die Lage und Orientierung des relevanten 
Punktes (5 t 6, 7) im Flansch-Koordinaten-System (9) 
berechnet wird 

2. Verfahren nach Anspruch 1, dadurch gekenn- 
zeichnet, daB zur Bestimmung von Lage und Orien- 5 
tierung des Flansch-Koordinaten-Systems (9) der 
Referenzpunkt (10) in mindestens drei gew&hlte re- 
presentative Punkte (16, 17, 18, 19) des Flansch-Ko- 
ordinaten-Systems (9) fiktiv verlegt wird, wobei die 
Ortskoordinaten der repr&sentativen Punkte (16, 10 
17, 18, 19) im World- Koordinaten -System (8) aufge- 
nommen werden, und daB daraus die Lage und 
Orientierung des Flansch-Koordinaten-Systems (9) 
gegenuber dem World-Koordinaten-System (8) be- 
rechnet werden. 15 

3. Verfahren nach Anspruch 2, dadurch gekenn- 
zeichnet, daB die reprasentativen Punkte (16, 17, 18, 
19) auf den Ursprung und mindestens zwei Achsen 
des Flansch-Koordinaten-Systems (9) verlegt wer- 
den. 20 

4. Verfahren nach Anspruch 1 oder einem der fol- 
genden, dadurch gekennzeichnet, daB Lage und 
Orientierung des relevanten Punktes (5, 6, 7) im 
Flansch-Koordinaten-System (9) durch Hohenab- 
stand (T), Seitenversatz (L) und Drehwinkel (D) um 25 
die z-Achse bestimmt werden. 

5. Verfahren nach Anspruch 1 oder einem der fol- 
genden, dadurch gekennzeichnet, daB die Ortsko- 
ordinaten des Referenzpunktes (10) durch vorheri- 
ges Anfahren mit einem bekannten Werkzeug be- 30 
stimmt werden. 

6. Verfahren nach einem oder mehreren der An- 
spruche 1 bis 4, dadurch gekennzeichnet, daB der 
relevante Punkt (5, 6, 7) des Werkzeugs (4) an einen 
wahlbaren Referenzpunkt (10) im Erfassungsbe- 35 
reich eines auf das World- Koordinaten-System (8) 
referierten Vermessungssystems (12) gefahren 
wird, wo seine Ortskoordinaten bestimmt werden. 

7. Verfahren nach Anspruch 6, dadurch gekenn- 
zeichnet, daB der relevante Punkt (5, 6, 7) optisch 40 
erf aBt und verm esse n wird 

8. Verfahren nach Anspruch 1 oder einem der fol- 
genden, dadurch gekennzeichnet, daB die Rechen- 
operationen in der Manipulatorsteuerung (15) 
durchgefuhrt werden. 45 
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